close all;clear;clc;

% 文件路径
filename = 'hdf5/cvae-sync.hdf5';

% 读取 catch_shoes_20250313 组的数据
current_pos = h5read(filename, '/catch_shoes_20250313/current_pos');
qpos = h5read(filename, '/catch_shoes_20250313/qpos');

process_result = h5read(filename, '/catch_shoes_20250313/process_result');


% 读取 control 组的数据
aim_pos = h5read(filename, '/control/aim_pos');
real_pos = h5read(filename, '/control/real_pos');
torques = h5read(filename, '/control/torques');
vels = h5read(filename, '/control/vels');

%%

% 绘制实际位置
checkbox_plot(qpos, 14, 'qpos');

%
checkbox_plot(real_pos, 20, 'real_pos');

% 绘制实际速度
checkbox_plot(vels, 20, 'vels');

% TODO
% 绘制current_pos 忘了是干什么的了
checkbox_plot(current_pos, 14, 'current_pos');



